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(54) TWO-LEGGED WALKING LOCOMOTION APPARATUS AND ITS WALKING CONTROLLER 



(57) A walk controller(30) for a biped (two-footed) 
walking mobile system, which drive-controls each joint 
drive motor (15L, 15R - 20L, 20R) of each leg portion 
(13L, 13R) of a biped walking mobile system based on 
gait data, includes a force detector (23L, 23R) to detect 
the force allied to a sole of each foot portion (14L, 14R), 
and a compensator (32) to modify the gait data from a 
gait former (24) based on the force detected by a force 
detector, and is constituted so that each force detector 
(23L, 23R) comprises at least three 3-axial force sen- 
sors (36a, 36b, 36c) allocated on a sole of each foot por- 
tion (14L, 14R), and a compensator (32) modifies gait 
data based on the detected signals from three 3-axial 
force sensors (36a, 36b, 36c) which detect effective 
force, thereby the walk stability of a robot is realized, 
even on the unstable road surface condition with com- 
plex roughness. 
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Description 

Technical Field 

s [0001] The present invention relates to a biped (two-footed) walking mobile system, and more specifically to its walk 
control system which leads to stable walking. 

Background Art 

10 f00021 A conventional biped walking robot generates the pre-designed walk pattern (hereinafter to be called "gait'') 
data, conducts walk control according to said gait data, moves foot portions by the predetermined walk pattern, and 
thereby realizes biped walking. 

However such a biped walking robot tends to be unstable in walking posture upon walking due, for example, to road 
surface conditions, or the error of the robot's own physical parameters, or else, and may tumble down in some cases 

ts on the other hand if a robot is made to conduct walk control without pre-designed gait data while confirming walk 
conditions in real time, then walking is possible with stable walking posture, but even in such cases, the robot may 
tumble down with collapsed walking posture, when unexpected road conditions are encountered. 
[00031 Therefore, what is called ZMP compensation is required, whereby the points on the sole of a foot of the robot 
where the composite momentum of floor reaction force and gravity becomes zero (hereinafter to be called ZMP "Zero 

20 Moment Point") are converged to the target value. As such a control method for ZMP compensation, the method to 
accelerate and adjust the robot's upper body by utilizing compliance control and converging ZMP to the target value, 
as shown for example in JP 5-305583 A, or the control method to adjust the landing position of the robot's foot is known. 

Incidentally, in such control methods, the stabilization of a robot is aimed by ZMP regulation, and in said ZMP 
regulation there should be a prerequisite to accurately detect floor reaction force at a sole. 

25 [0004] However as for a biped walking robot of such structure, there may be such cases where a whole sole does 
not land on the road surface in the unstable road condition with complex roughness, and floor reaction force at a sole 
can not be accurately detected, and thereby ZM P compensation can not be accurately conducted. For this reason, the 
robot's stability can not be maintained, and the robot's biped walking becomes difficult. 

30 Disclosure of the Invention 

[0005] It is the object of the present invention, taking into consideration the above-mentioned problems, to provide 
a biped walking mobile system and its walk control system to realize walk stability by accurately detecting floor reaction 
force at a sole in the unstable road condition with complex roughness. 

35 The above-mentioned objective is achieved in accordance with the first aspect of the present .nvention with the 

biped walking mobile system, which comprises a main body having at both sides of its lower part a pair of leg portions 
attached thereto so as to be each pivotally movable biaxially, each of the leg portions having a knee portion in its 
midway and a foot portion at its lower end, the foot portions being attached to their corresponding leg portions so as 
to be pivotally movable biaxially, the drive means for pivotally moving said leg, knee, and foot portions, a gait former 

40 to form gait data including target angle orbital, target angle velocity, and target angle acceleration corresponding to 
the required motion, and a walk control system to drive-control said drive means based on said gait data. Said walk 
control system includes a force detector to detect the force applied on the soles of respective feet, and a compensator 
to modify the gait data from a gait former based on the force detected by said force detector, and said force detector 
comprises at least three 3-axial force sensors allocated on the soles of respective feet, and said compensator modifies 

45 the gait data based on the detected signals from three 3-axial force sensors which detect effective force among re- 
spective 3-axial force sensors of force detectors. 

[0006] A biped walking mobile system in accordance with tho present invention is preferably provided with said mam 
body which is the upper body of a humanoid robot, and a head portion and both hand portions are attached thereto. 
A biped walking mobile system in accordance with the present invention is preferably such that its respective 
so 3-axial force sensor protrudes from a sole downward. Preferably, three 3-axial force sensors are allocated at three 
tops of an isosceles triangle on a sole of respective foot portion, or each 3-axial force sensor may be allocated on a 
periphery of a circle with the center on the vertical drive axis of a foot portion on a sole of respective foot portion. 
[0007] A biped walking mobile system in accordance with the present invention is preferably such that its respective 
foot portion comprises an base portion attached directly to the lower end of a leg portion, and a toe portion as a finger 
tip attached pivotally movably vertically to the end of said base portion, and each 3-axial force sensor of a lorce detector 
is distributed on an base portion and a toe portion. 

A biped walking mobile system in accordance with the present invention is preferably such that one of its 3-axial 
force sensors is allocated near an base portion, and another 3-axial force sensor is allocated near the tip of a toe 
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portion, and still two other 3-axia! force sensors are allocated left and right in the region near the border of an base 
portion and a toe portion. 

A biped walking mobile system in accordance with the present invention is preferably such that said compensator 
automatically calibrates the detected signals from each 3-axial force sensor by autocalibration. 

5 [0008] The above-mentioned objective is also achieved in accordance with the second aspect of the present invention 
with the biped walking mobile system, which comprises a main body having at both sides of its lower part a pair of leg 
portions attached thereto so as to be each pivotally movable biaxially, each of the leg portions having a knee portion 
in its midway and a foot portion at its lower end, the foot portions being attached to their corresponding leg portions 
so as to be pivotally movable biaxially, the drive means for pivotally moving said leg, knee, and foot portions. The walk 

10 control system of said biped walking mobile system drive-controls said drive means based on the gait data formed by 
a gait former including target angle orbital, target angle velocity, and target angle acceleration corresponding to the 
required motion, and comprises a force detector to detect the force applied on the soles of respective feet, and a 
compensator to modify the gait data from a gait former based on the force detected by said force detector, and said 
force detector comprises at least three 3-axial force sensors allocated on the soles of respective feet, and said com- 

15 pensator modifies the gait data based on the detected signals from three 3-axial force sensors which detect effective 
force among respective 3-axial force sensors of force detectors. 

[0009] A walk control system of a biped walking mobile system in accordance with the second aspect of the present 
invention is preferably such that its respective 3-axial force sensor protrudes from a sole downward. Also preferably, 
three 3-axial force sensors are allocated at three tops of an isosceles triangle on a sole of respective foot portion, or 
20 each 3-axial force sensor may be allocated on a periphery of a circle with the center on the vertical drive axis of a foot 
portion on a sole of respective foot portion. 

A walk control system of a biped walking mobile system in accordance with the present invention is preferably 
such that said compensator automatically calibrates the detected signals from each 3-axial force sensor by autocali- 
bration. 

25 [0010] According to said aspect, a drive means is drive-controlled by modifying by a compensator the gait data from 
a gait former based on the force detected by a force detector comprising at least three 3-axial force sensor allocated 
on a sole of each foot portion. In that case, when a foot portion lands on the road surface with complex roughness, the 
three 3-axial force sensors protruding downward from a sole steadily contact the road surface. Therefore, the stabili- 
zation of a main body, for example, a humanoid robot's upper body can be maintained by accurately modifying the gait 

30 data based on the detected signal from three 3-axial force sensors which detect effective force even on unstable road 
surface. Accordingly, even on unstable road surface with complex roughness, a sole of each foot portion of a robot 
can maintain the stability of a robot, and make possible steady walk control. 

In case that three 3-axial force sensors are allocated at three tops of an isosceles triangle on a sole of respective 
foot portion, two of the 3-axial force sensors at the both ends of the bottom side of an isosceles triangle are in sym- 

35 metrical condition, therefore the weight loaded on each 3-axial force sensor can be distributed evenly on left and right, 
and each 3-axial force sensor can be easily calibrated. 

In case that each 3-axial force sensor is allocated on a periphery of a circle with the center on the vertical drive 
axis of a foot portion on a sole of respective foot portion, the torques around said vertical drive axis are in the same 
condition, therefore the loads with respect to said torques can be evenly distributed to each 3-axial force sensor, and 

40 each 3-axial force sensor can be easily calibrated with respect to the torques. 

[0011] In case that each foot portion comprises an base portion attached directly to the lower end of a leg portion, 
and a toe portion as a finger tip attached pivotally movably vertically to the end of said base portion, and each 3-axial 
force sensor of a force detector is distributed on an base portion and a toe portion, when only an base portion or a toe 
portion is in contact with the ground, each 3-axial force sensor of a force detector can detect the floor reaction force 

45 on a sole. 

In case that one of the 3-axial force sensors is allocated near an base portion, and another 3-axial force sensor 
is allocated near the tip of a toe portion, and still two other 3-axial force sensors are allocated left and right in the region 
near the border of an base portion and a toe portion, when only an base portion or a toe portion is in contact with the 
ground, three 3-axial force sensors of a force detector are in contact with the ground, and can accurately detect the 
50 floor reaction force on a sole. 

In case that said compensator automatically calibrates the detected signals from each 3-axial force sensor by 
autocalibration, even if the detection accuracy is changed in respective 3-axial force sensor of a force detector due to 
the surrounding temperature or ageing, autocalibration is conducted, and the floor reaction force can be accurately 
detected by the detected signals from each 3-axial force sensor of a force detector. 

55 

Brief Description of the Drawings 

[0012] The present invention will better be understood from the following detailed description and the drawings at- 
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tached hereto showing certain illustrative forms of embodiment of the present invention. In this connection, it should 
be noted that such forms of embodiment illustrated in the accompanying drawings hereof are intended in no way to 
limit the present invention but to facilitate an explanation and an understanding thereof, in which drawings: 

5 Fig.1 is a schematic view illustrating the mechanical makeup of a biped walking robot according to the present 

invention as one form of embodiment thereof; 

Fig.2 is a block diagram illustrating the electrical makeup of a biped walking robot shown in Fig.1 ; 
Fig.3 illustrates the allocation of a 3-axis force sensor allocated on a sole of each foot portion of a biped walking 
robot shown in Fig. 1 , and (A) is the brief perspective view seen diagonally from the upper side, and (B) is the brief 
10 perspective view seen diagonally from the lower side; 

Fig.4 is a plan view of a sole illustrating the allocation of 3-axis force sensors shown in Fig.3; 

Fig.5 is a graph illustrating the allocation of each 3-axis force sensor and the base position of force measurement 

shown in Fig.4; 

Fig. 6 is a flowchart illustrating the walk control motion of a biped walking robot shown in Fig.1 ; 
is Rg. 7 is a plan view of a sole illustrating the first modified example of the allocation of a 3-axis force sensor shown 

in Fig. 3(C); 

Fig.8 is a plan view of a sole illustrating the second modified example of the allocation of a 3-axis force sensor 
shown in Fig.3(C); 

Fig.9 illustrates the third modified example of the allocation of a 3-axial force sensor shown in Fig.3(C), and (A)is 
20 a side view of a foot portion, and (B) is a plan view of a sole; 

Fig.1 0 is, in case of landing at a toe portion in a modified example shown in Fig.9, and (A) is a side view of a foot 
portion, and (B) is a plan view of a sole; 

Fig.1 1 is a plan view of a sole illustrating the fourth modified example of the allocation of a 3-axis force sensor 
shown in Fig.3(C). 

25 

Best Modes for Carrying out the Invention 

[0013] Hereinafter, the present invention will be described in detail with reference to suitable forms of embodiment 
thereof illustrated in the figures. 

30 Fig.1 and Fig.2 show the makeup of an embodiment of a biped walking robot with a biped walking mobile system 

applied thereto in accordance with the present invention. Referring to Fig. 1 , a biped walking robot 1 0 includes an upper 
body 1 1 as a main body having at both sides of its lower part a pair of leg portions 1 3L and 1 3 R attached thereto, each 
of the leg portions having a knee portion 12L, 12R in its midway, and a foot portion 14L, 14R at its lower end. 
[001 4] Here, each of said leg portions 1 3L, 1 3R has six joint portions, namely in the order from above, the joint portion 

35 1 5L, 1 5R for the leg portion rotation of a waist (around z axis) with respect to the upper body 1 1 , the joint portion 1 6L, 
16R for the roll direction of a waist (around x axis), the joint portion 17L, 17R for the pitch direction of a waist (around 
y axis), the joint portion 18L, 18R for the pitch direction of a knee portion 12L, 12R, the joint portion 19L, 19R for the 
pitch direction of an ankle portion with respect to a foot portion 14L, 14R, and the joint portion 20L, 20R for the roll 
direction of an ankle portion. Each joint portion 15L, 15R to 20L, 20R is made up with a joint driving motor. Thus, a 

*o waist joint comprises said joint portions 15L, 15R, 16L, 16R, 17L, and 17R, and a foot joint comprises joint portions 
19L, 19R, 20L, and 20R. 

[001 5] Further between a waist and a knee joints, they are connected with the thigh links 21 L, 21 R, and between a 
knee and a foot joints, they are connected with the lower thigh links 22L, 22R. Thus, the leg portions 13L, 13R and the 
foot portions 1 4L, 1 4R at both sides, left and right, of a biped walking robot 1 0 have six degrees of freedom, respectively, 

45 and it is so made up to be capable of walking at will in a three dimensional space by drive-controlling these twelve joint 
portions during walk with respective drive motors at appropriate angles, and by giving desired motions to whole leg 
portions 13L, 13R, and foot portions 14L, 14R. Further, said foot portions 14L, 14R are provided with force detectors 
23L, 23R on soles (bottom faces). Said force detectors 23L, 23R are to detect, as described below, the forces on 
respective foot portions 1 4L, 1 4R, especially the horizontal floor reaction force F. Here, said upper body 1 1 is illustrated 

50 like a mere box, but actually it may be provided with a head portion or two hands. 

[0016] Fig.2 illustrates the electrical makeup of a biped walking robot 10 shown in Fig.1. In Fig.2, a biped walking 
robot 1 0 is provided with a gait former 24 to form a gait data corresponding to the desired motion, and a walk controller 
30 to drive-control the drive means, that is, the joint drive motors 15L, 15R to 20L, 20R of the above-mentioned joint 
portions based on said gait data. 

55 Here, xyz coordinate system is used as that for a biped walking robot 10 with x direction as anteroposterior 

direction ( forward as +), with y direction as horizontal direction ( inner direction as +), and with z direction as vertical 
direction ( upper direction as +). 

[0017] Said gait former 24 is to form the gait data including the target angle orbital, target angle velocity, and target 
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angle acceleration of respective joint portions 1 5L, 15R to 20L, 20R necessary for the walk of the biped walking robot 
1 0, based on the desired motion input from outside. 

Said walk controller 30 is made up with an angle measurement unit 31 , a compensator 32, a controller 33, and 
a motor control unit 34. 

5 [0018] Into said angle measurement unit 31 , the angle information of the respective joint drive motor is input by, for 
example, a rotary encoder or else, provided in the joint drive motor of respective joint portion 15L, 15R to 20L, 20R, 
the angular position of respective joint drive motor, that is, the state vector 4 with respect to the angle and the angle 
velocity is measured, and output to the compensator 32. Said compensator 32 calculates the floor reaction force F 
based on the detected output from a force detector 23L, 23R, modifies the gait data from the gait former 24 based on 

10 said floor reaction force F and the state vector <j> from an angle measurement unit 31 , and outputs the vector Gi ( i =1 
to n, where n is the degree of freedom with respect to a robot 10's walk) to the controller 33. Here, said controller 33 
subtracts the angle vector 90 at a robot's respective joint portion from the vector 8i as the gait data modified by the 
compensator 32, and forms the control signal of each joint drive motor, that is, torque vector t, based on the vector (6i 
- 60). Further, said motor control unit 34 drive-controls each joint drive motor according to the control signal from the 

is controller 33 ( torque vector t). 

[001 9] Here, since said force detectors 23L, 23R have a symmetrical makeup left and right, explanation will be given 
for a force detector 23L only referring to Fig.3. In Fig.3, the force detector 23L is made up, on the bottom side of a sole 
plate 35 as the lower face of the foot portion 1 4L, of three 3-axis force sensors 36a, 36b, and 36c allocated at the both 
sides of front rim and the center of rear rim. 

20 Respective 3-axis force sensors 36a, 36b, and 36c have the mutually identical makeup, and, as shown in Fig.3 

(A) and (B), are made up to protrude downward from a sole. Further, respective 3-axis force sensors 36a, 36b, and 
36c are allocated, as shown in Fig.4, at respective tops of an isosceles triangle with a spired rear rim. 
[0020] Respective 3-axis force sensors 36a to 36c have data fluctuation for respective detected output, and the 
detected output varies by the surrounding temperature or ageing. Consequently, the detected outputs of the respective 

25 3-axis force sensors 36a to 36c are automatically calibrated in the compensator 32 by the auto calibration as explained 
below. 

First of all, explanation will be given to the calibration in the direction of Z axis. 

In Fig.5(A), n 3-axis force sensors S1 , S2, S3, — , Sn are allocated on a sole with respect to the origin of force 
measurement 0(Ox, Oy). The origin of force measurement O is preferably agreed to the drive coordinate system of, 
30 for example, the joint of a foot portion. Here, the position of respective 3-axis force sensor Si is assumed as Si = (X(i), 
Y(i)), and arbitrary three 3-axis force sensors, for example, S1 , S2, and S3 are chosen out of the 3-axial force sensors 
S1 to Sn distributed as mentioned above, and their coordinate positions are respectively assumed as S1=X(1) Y(1) 
Z(1), S2=X(2), Y(2), Z(2), S3=X(3), Y(3), Z(3). 

The state of three point support is made so that the loads are applied only to said three 3-axis force sensors S1 
35 to S3, and, as shown in Fig.5(B), arbitrary two 3-axis force sensors among the three, for example, S1 and S2 are 
connected with a straight line, and the cross point of the perpendicular line from the remaining one 3-axis force sensor 
S3 to said straight line is assumed as C. 

Here, the center of gravity of the driven object is moved statically along said perpendicular line from S3 to C, and 
then the voltage values output from S1 to S3 are measured. In this case, the more the measurement points, the more 
40 accurate is calibration. 

[0021] Assume f as the measured force, A,B as calibration parameters, V as the voltage value at that instant, M as 
the total mass of the driven object, g as the acceleration of gravity, and k as the measurement point, then the relating 
equations are obtained. 
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f /,<n, *(W,<:>^(2) + /,<,,* *(3) = 0 
/.(„* HD + /,<:,» > r (2) + /.(3, 4 - H3) = 0 



(0 



f00221 And by assuming V, M, Y as known values and solving these equations as the simultaneous equations of f, 
and by substituting the obtained result into the equation below, the required slope A of F/V straight line and the mtercept 
B are obtained at the same time. Further, by measuring n times, the calibration parameter for calibrat.on can be cal- 
culated. 
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[0023] Thus the calibration in the direction of Z axis with respect to said three 3-axis force sensors S1 to S3 are 
completed And by choosing other different three 3-axis force sensors, repeating calculation of the calibration param- 
eters likewise, and conducting calculation of the calibration parameters for ail 3-axis force sensors, the calibration in 
the direction of Z axis can be completed for all 3-axis force sensors. 
[0024] Further, the method of calibration with respect to X and Y axes will be explained. 

First as shown in Fig.5(C), arbitrary two 3-axis force sensors, for example, S1 and S2 are chosen out of the 
distributed 3-axis force sensors S1 to Sn, and a robot's upper body 11 or the leg portion of the opposite side 13L or 
13R are utilized, and thereby the momentum m around Z axis is generated. Here, F1 = F2 for the forces F1 and F2 
applied on to 3-axis force sensors S1 , S2, and momentum m is expressed by the equation below. 



m=F1« V(X(1)-X(2)) 2 + (V(1)- Y(2)) 2 



[0025] Consequently, forces F1 , F2 applied on to individual 3-axis force sensors S1 , S2 are calculated, and the 
respective X and Y components are expressed by the equation below. 



35 



40 



f m = F\smd 
f jm =F2.cos9 
fym = F2sxn9 



where 



{ n2)-n\) ) 

so [0026] On the other hand, the relationship between the voltage value V output from respective 3-axis force sensors 
S1 , S2 and the forces fx, fy is expressed by the equations below, with k as the number of measurement. 
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f fx{\)k - Ax{\)K[\)k + ^(l) 
/x(2)* = 4(2)^1(2)* + 5 *{2) 

5 1 

fy{2)k = ^y(1) V y{7)k + ^y(2) 

to With these equation combined, and by measurements of n times, the determinants as shown below is obtained, 

and the calibration parameters A, B can be calculated. 



15 



' z; 

^L^k~ 



o 



20 


* Zi 























25 Thus, by simultaneously calculating the calibration parameters A, B in the directions of X and Y axes, calibration 

can be made in the XY axis directions. 

Incidentally for the above-mentioned calibration, when respective 3-axis force sensors 36a to 36c are allocated 
at the tops of an Isosceles triangle as shown in Fig. 4, the calibration parameters by calibration have the same value, 
since the 3-axis force sensors 36a, 36b allocated at both ends of the front bottom side of the triangle are in symmetric 

30 position left and right. Therefore, calibration can be easily conducted. 

[0027] The biped walking robot 10 in accordance with an embodiment of the present invention is made up as de- 
scribed above, and its walking motion is conducted as described below according to the flowchart in Fig.6. 

In Fig.6, first of all by the step ST1 , the gait data is formed by the gait former 24 based on the desired motion 
(J=J) which is input, and then is output to the compensator 32 of the walk controller 30. And by the step ST2, respective 

35 forces are detected by force detectors 23L, 23R provided on both foot portions 14L, 14R, and are output to the com- 
pensator 32. Also by the step ST3, the state vector § of respective joint portions 1 6L, 1 6R to 20L, 20R is measured by 
the angle measurement unit 31, and is output to the compensator 32. By the step ST4 which follows, floor reaction 
force F is calculated by the compensator 32 based on the detected output from the force detectors 23L, 23R. And by 
the step ST5, the compensator 32 modifies the gait data based on said floor reaction force F and the state vector <j> of 

^o respective joint portions 1 6L, 1 6R to 20L, 20R from the angle measurement unit 31 , and outputs Gi to the controller 33. 

Next by the step ST6, said controller 33 subtracts the angle vector G 0 at a robot's respective joint portion from 
the vector 8i and forms the control signal of each joint drive motor, that is, torque vector x, based on the vector ( Gi - 
00), and outputs it to the motor control unit 34. And by the step ST7, said motor control unit 34 drive-controls the joint 
drive motors of respective joint portions based on said torque vector t. As a result, the biped walking robot 1 0 conducts 

45 walking motion corresponding to the desired motion. 

After that, by the step ST8, the controller 33 makes J=J+1 by motion counter increment, and waits for the pre- 
set sampling time, thereafter by the step ST9, if said J is below the pre-sct motion finishing count, then the step is 
returned to ST2. and the above-mentioned motion is repeated. And at the step ST9, if said J exceeds the motion 
finishing count, then the motion is stopped. 

so [0028] In this case, for the biped walking robot 1 0 to drive-control each joint drive motor, the gait data is modified in 
the compensator 32 based on the horizontal floor reaction force F by the detected signal from each 3-axis force sensor 
36a, 36b, and 36c of the force detectors 23L, 23R allocated on the sole of each foot portion 14L, 14R, and the vector 
6i is formed, thereby a robot 10's stability can be attained with said horizontal floor reaction force F as regulation. 
Accordingly, oven if a robot 1 0's each foot portion 1 4L, 1 4R, for example, each sole lands on the unstable road surface 

55 with complex roughness, each 3-axis force sensor 36a. 36b, and 36c of the force detector 23L, 23R allocated on the 
sole steadily lands on the ground, and can detect the horizontal floor reaction force F, thereby the walking motion 
corresponding to the required motion can be made surely possible. 

[0029] Fig. 7 and Fig. 8 illustrate other examples of the makeup of each 3-axis force sensor of force detectors 23L, 
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23R described above. 

First in Fig.7, respective 3-axis force sensors 36a, 36b, and 36c are allocated at tops of an equilateral triangle. 
According to such allocation of 3-axis force sensors 36a, 36b, and 36c, since the loaded weights on respective 3-axis 
force sensors 36a, 36b, and 36c are uniformly distributed, as well as acting similarly with the 3-axis force sensors 36a 
5 to 36c in Fig.4, the load is reduced on respective 3-axis force sensors 36a, 36b, and 36c. 

In Fig. 8, respective 3-axis force sensors 36a, 36b, and 36c are allocated at tops of an isosceles triangle like in 
Fig.4, as well as on a single periphery with the vertical drive axis 0 with respect to leg portions 1 3L, 1 3R of foot portions 
14L, 14R as the center. According to such allocation of 3-axis force sensors 36a, 36b, and 36c, they act similarly with 
the 3-axis force sensors 36a to 36c in Fig.4, as well as the torque calibration around said vertical drive axis 0 can be 
10 easily conducted. 

[0030] Fig.9 to Fig. 11 illustrate still other examples of the makeup of each 3-axis force sensor of force detectors 23L, 
23R described above, and in these makeup examples, each foot portion 14L, 14R comprises each base portion 14La, 
HRa directly attached to each leg portion 13L, 13R, and a toe portion 14Lb, 14Rb as a finger tip pivotally movably 
attached vertically to each base portion 14La, 14Ra. Here, toe portions 14Lb, 14Rb may be actively pivotable with 

15 respect to base portions 14La, 14Ra by drive means like other joint portions, or may be passively pivotable. 

In Fig.9, a toe portion 1 4Lb, 1 4Rb is provided with a 3-axis force sensor 36d at the position lopsided to the inner 
side of a tip, and respective 3-axis force sensors 36e, 36f at the positions near both ends of a rear side, while a base 
portion 1 4La, 1 4Ra is provided with one 3-axis force sensor 36g on the heel portion of its rear side. 
[0031] On the other hand, the compensator 32 chooses the 3-axis force sensor which detects, for example, larger 

20 force based on the detected signal of each 3-axial force sensor 36d to 36g of a force detector 23L, 23R, and modifies 
the gait data based on the horizontal floor reaction force by three 3-axis force sensors 36d to 36g which detect effective 
forces. 

According to such allocation of 3-axis force sensors 36d, 36e, 36f and 36g, if the base portion 1 4La, 1 4Ra of the 
foot portion 14L, 14R contacts the road surface, then, as shown in Fig.9(A), three 3-axis force sensors 36e, 36f, and 

25 36g, two 3-axial force sensors 36e, 36f allocated on the rear side of the toe portion 14Lb, 14Rb, and one 3-axis force 
sensor 36g allocated on the rear side of the base portion 1 4La, 1 4Ra, contact the floor surface, bear the loaded weight 
as shown with the hatched line in Fig.9(B), and the horizontal floor reaction force is applied from the floor surface. 
Therefore, the compensator 32 calculates the horizontal floor reaction force based on the detected signals from the 
above-mentioned three 3-axis force sensors 36e, 36f, and 36g, and modifies the gait data. 

30 [0032] On the other hand, in case that only the toe portion 14Lb, 14Rb of the foot portion 14L, 14R contacts the road 
surface upon the change of walking posture, as shown in Fig. 10(A), three 3-axis force sensors 36d, 36e, and 36f 
provided at the tip and the rear sides of the toe portion 14Lb, 14Rb contact the floor surface, bear the loaded weight 
as shown with the hatched line in Fig.10(B), and the horizontal floor reaction force is applied from the floor surface. 
Therefore, the compensator 32 calculates the horizontal floor reaction force based on the detected signals from 

35 the above-mentioned three 3-axis force sensors 36d, 36e, and 36f, and modifies the gait data. Thus, even if the con- 
tacting state of the foot portion 1 4L, 14R on to the floor surface is changed upon the change of walking posture, three 
3-axis force sensors 36e, 36f , and 36g, or 36d, 36e, and 36f detect the effective force by receiving the horizontal floor 
reaction force from the floor surface, and the compensator 32 can accurately modify the gait data. 
[0033] In Fig.11, as for each 3-axis force sensor 36d to 36g, by comparison with the case of Fig.9, 3-axis force 

40 sensors 36h, 36i are each allocated at both ends of a tip of the base portion 14La, 1 4Ra in place of the 3-axis force 
sensors 36e, 36f allocated at both sides of the rear end of the toe portion 14Lb. 14Rb, and a 3-axis force sensor 36d 
of a tip of the toe portion 14Lb, 14Rb is allocated at about a center with respect to the left and right direction. Thus, 
3-axis force sensors 36h, 36i are allocated at each top of an isosceles triangle with respect to a 3-axis force sensor 
36d or 36g. 

45 According to such allocation of 3-axis force sensors 36d, 36h, 36i and 36g, they act similarly with the 3-axis force 

sensors 36d to 36g in Fig.9, and can conduct calibration easily for the middle 3-axis force sensors 36h, 36i, and further, 
can be more firmly attached to foot portions 14L, 14R by being attached to the base portions 14La, 14Ra which is 
larger than toe portions 14Lb, 14Rb. 

Here in Fig. 11 , the middle 3-axis force sensors 36h, 36i are each provided to both sides of the tip of base portions 

so ULa, 14Ra, but, not limited to this case, may be provided to the connecting region of base portions 14La, 14Ra and 
toe portions 14Lb, 14Rb. 

[0034] Thus in case of the biped walking robot 10 according to the embodiment of the present invention, respective 
3-axis force sensors 36a to 36c, or 36d to 36g, or 36d, 36h, 36i ( and 36g of force detectors 23L, 23R provided on the 
soles of respective foot portions 14L, 14R firmly land on to the road surface with complex roughness. Consequently, 
55 by modifying gait data based on the horizontal floor reaction force F calculated from the detected signal from each 
3-axis force sensor, walk control can be conducted with the horizontal floor reaction force F generated from the friction 
of a sole with the floor surface as regulation, and the walk stabilization of the robot 10 can be achieved in the unstable 
road surface state with complex roughness. 
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[0035] In the above-mentioned embodiment, for example, in Fig.4, Fig. 7, Fig.8, Fig.9,and Fig. 1 1 , 3-axis force sensors 
are allocated symmetrically left and right, but, not limited as such, it may be obviously an allowable case to be allocated 
at the tops of an inequilateral triangle. Also in the above-mentioned embodiment, 3-axis force sensors are allocated 
on the bottom side of a plate which makes up each sole, but, not limited as such, it may also be an allowable case that 
other plate is attached to the lower part of a 3-axis force sensor, and said 3-axis force sensor is inserted between said 
plates. In this case, said 3-axis force sensor can detect not only compressing force but also pulling force. 

Here in such a sensor structure, if each 3-axis force sensor, for example, is allocated in even position on a sole, 
respectively, with respect to the directions back and forth and left and right, force amplification and calibration are easily 
conducted, as well as a sensor can be most efficiently used. 

[0036] Also in the above-mentioned embodiment, for example, in Fig.4, Fig.7, and Fig.8, the force detector 23L, 23R 
is provided with three 3-axis force sensor 36a, 36b, and 36c, respectively, and in Fig.9 and Fig. 11 , always three 3-axis 
force sensors 36d, 36e (36h), 36f (36i), or 36e (36h), 36f (36i), 36g of the force detector 23L, 23R land on the floor 
surface, but not limited as such, three or more 3-axis force sensors may be provided, respectively. For example, as 
shown with a broken line in Fig.4, two 3-axis force sensors 36j, 36k may be provided in the middle region. In this case, 
the compensator 32 compares the detected signals of respective 3-axis force sensors 36a, 36b, 36c, 36j, and 36k, 
and chooses three 3-axis force sensors which detect larger force, and may calculate the horizontal floor reaction force 
from the chosen three 3-axis force sensors. 

[0037] Further in the above-mentioned embodiment, a compensator 32 modifies the gait data with the horizontal 
floor reaction force as regulation based on the detected signals from respective 3-axis force sensors of the force de- 
tectors 23L, 23R, but not limited as such, it may be obviously an allowable case to modify the gait data with ZMP 
regulation based on the detected signals from respective 3-axis force sensors of force detectors 23L, 23R, as were 
the past cases. 

Further in the above-mentioned embodiment, explanation was given to the case where the present invention is 
applied to a biped walking robot, but not limited as such, it is obvious that the present invention is applicable to a biped 
walking mobile system in which other various machines are supported on two legs, and said two legs make it possible 
to walk. 

Industrial Applicability 

[0038] According to the present invention as described above, a quite excellent biped walking mobile system and a 
walk control system therfor are provided, which can realize the walk stability by accurately detecting the floor reaction 
force on soles of a robot, even in the unstable road surface condition with complex roughness. 



Claims 

1 . A biped walking mobile system comprising; 

a main body, a pair of leg portions attached thereto at both sides of its lower part so as to be each pivotally 
movable biaxially, each of the leg portions having a knee portion in its midway and a foot portion at its lower end, 
the foot portions being attached to their corresponding leg portions so as to be pivotally movable biaxially, drive 
means pivotally moving each leg, knee, and foot portion, a gait former to form a gait data including target angle 
orbital, target angle velocity, and target angle acceleration, and a walk controller to drive-control said drive means 
based on said gait data, 

said walk controller includes a force detector to detect a force applied on a sole of each foot portion, and a 
compensator to modify the gait data from the gait former based on the force detected by said force detector, 

wherein said force detector comprises at least three 3-axis force sensors allocated on the sole of each foot 
portion, and 

wherein said compensator modifies the gait data based on detected signals from three 3-axis force sensors 
which detect effective force among respective 3-axis force sensors of the force detector. 

2. A biped walking mobile system as set forth in claim 1 or claim 2, characterized In that, said main body is a upper 
body of a humanoid robot provided with a head portion and two hand portions. 

3. A biped walking mobile system as set forth in claim 1 or claim 2, characterized In that, each 3-axis force sensor 
protrudes downward from a sole. 

4. A biped walking mobile system as set forth in either of the claims 1 to 3, characterized In that, three 3-axis force 
sensors are allocated at top positions of an isosceles triangle on a sole of each foot portion. 
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5 A biped walking mobile system as set forth in any one of claims 1 to 4, characterized In that, each 3-axial I force 
' sensor is allocated on a same periphery with the vertical drive axis of a foot portion as the center on a sole of each 

foot portion. 

6 a biped walking mobile system as set forth in any one of claims 1 to 5, characterized In that, 
each foot portion comprises an base portion attached directly to the lower end of the leg portion, and a toe 

oortion as a finger tip attached pivotally movably up and down at the end of said base portion, and 

each 3-axis force sensor of the force detector is distributed and allocated in the base portion and the toe 
portion. 

7 A biped walking mobile system as set forth in claim 6, characterized in that, one 3-axis force sensor is allocated 
' near a heel of the base portion, another 3-axis force sensor is allocated near a tip of the toe portion, and two other 

3-axis force sensors are allocated left and right in the region near the boundary of the base portion and the toe 
portion. 

8 A biped walking mobile system as set forth in any one of claims 1 to 7, characterized in that, said compensator 
automatically calibrates the detected signal from each 3-axis force sensor by auto calibration. 

9 A walk controller for a biped walking mobile system to drive-controls drive means based on a gait data including 
target angle orbital, target angle velocity, and target angle acceleration formed by a gait former corresponding to 
the required motion, comprising; 

a force detector to detect the force applied on a sole of each foot portion, and 

a compensator to modify the gait data from a gait former based on the force detected by said force detector, 
wherein said force detector comprises at least three 3-axis force sensors allocated on the sole of each foot 

PCrtl °wherein said compensator modifies gait data based on the detected signals from three 3-axis force sensors 
which detect effective force among respective 3-axis force sensors of the force detector, and 

wherein the biped walking mobile system comprising a main body, a pair of leg portions attached thereto at 
both sides of its lower part so as to be each pivotally movable biaxially, each of the leg portions having a knee 
30 portion in its midway and a foot portion at its lower end, the foot portions being attached to their corresponding leg 
portions so as to be pivotally movable biaxially, the drive means pivotally moving each leg, knee, and foot portion. 

10. A walk controller for a biped walking mobile system as set forth in claim 9, characterized In that, each 3-axis 
force sensor protrudes downward from a sole. 

35 

1 1 . A walk controller for a biped walking mobile system as set forth in claim 9 or claim 1 0, characterized In that, three 
3-axis force sensors are allocated at top positions of an isosceles triangle on a sole of each foot portion. 

12 A walk controller for a biped walking mobile system as set forth in any one of claims 9 to 11 , characterized in 
40 ' that, each 3-axis force sensor is allocated on a same periphery with the vertical drive axis of a foot portion as the 

center on a sole of each foot portion. 

13 A walk controller for a biped walking mobile system as set forth in any one of claims 9 to 12, characterized in 
that, each 3-axis force sensor is uniformly allocated on a sole of each foot portion with respect to the back and 

45 forth direction and the horizontal direction. 

14 A walk controller for a biped walking mobile system as set forth in any one of claims 9 to 13, characterized in 
' that, said compensator automatically calibrates the detected signal from each 3-axis force sensor by auto calibra- 
tion. 

50 
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FIG. 1 
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FIG. 5 
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FIG. 6 
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FIG. 7 
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